#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/fs.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <asm/uaccess.h>
#include <asm/irq.h>
#include <asm/io.h>
#include <asm/arch/regs-gpio.h>
#include <asm/hardware.h>

static struct class *firstdrv_class;
static struct class_device *firstdrv_class_dev[4];

volatile unsigned long *gpfcon = NULL;
volatile unsigned long *gpfdat = NULL;

static int first_drv_open(struct inode *inode,struct file *file)
{
	int minor = MINOR(inode->i_rdev);//取得次设备号
	
	printk("open minor=%d\n",minor);
	
	switch(minor) /* 根据不同的此设备号进行操作 */
	{
		case 0: /* /dev/leds 次设备号为0 三个LED一起操作 */
		{
			/*配置GPF456为输出*/
			*gpfcon &= ~((0x3<<(4*2))|(0x3<<(5*2))|(0x3<<(6*2)));
			*gpfcon |= ((0x1<<(4*2))|(0x1<<(5*2))|(0x1<<(6*2)));
		}
		break;
		case 1: /* /dev/led1 */
		{
			/*配置GPF4为输出*/
			*gpfcon &= ~((0x3<<(4*2)));
			*gpfcon |= ((0x1<<(4*2)));
		}
		break;
		case 2: /* /dev/led2 */
		{
			/*配置GPF5为输出*/
			*gpfcon &= ~((0x3<<(5*2)));
			*gpfcon |= ((0x1<<(5*2)));
		}
		break;
		case 3: /* /dev/led3 */
		{
			/*配置GPF6为输出*/
			*gpfcon &= ~((0x3<<(6*2)));
			*gpfcon |= ((0x1<<(6*2)));
		}
		break;
	}
	
	
	return 0;
}

static ssize_t first_drv_write(struct file *file,const char __user *buf,size_t count,loff_t *ppos)
{
	char val;
	int minor = MINOR(file->f_dentry->d_inode->i_rdev);
	copy_from_user(&val,buf,1);
	
	printk("write minor=%d val=%d\n",minor,val);
	
	switch(minor)
	{
		case 0:
		{
			if(val==1)
			{
				/* 点灯 */
				*gpfdat &= ~((1<<4) | (1<<5) | (1<<6));
			}else{
				/* 灭灯 */
				*gpfdat |= (1<<4) | (1<<5) | (1<<6);
			}
		}
		break;
		case 1:
		{
			if(val==1)
			{
				/* 点灯 */
				*gpfdat &= ~((1<<4) );
			}else{
				/* 灭灯 */
				*gpfdat |= (1<<4) ;
			}
		}
		break;
		case 2:
		{
			if(val==1)
			{
				/* 点灯 */
				*gpfdat &= ~((1<<5) );
			}else{
				/* 灭灯 */
				*gpfdat |= (1<<5) ;
			}
		}
		break;
		case 3:
		{
			if(val==1)
			{
				/* 点灯 */
				*gpfdat &= ~((1<<6) );
			}else{
				/* 灭灯 */
				*gpfdat |= (1<<6) ;
			}
		}
		break;
	}
	
	
	
	
	
	
	return 0;
}

static struct file_operations first_drv_fops = {
	.owner 	= THIS_MODULE,
	.open 	= first_drv_open,
	.write 	= first_drv_write,
};

int major;
int first_drv_init(void)
{
	int minor = 0;
	major = register_chrdev(0,"leds",&first_drv_fops); /* 注册驱动程序 */
	
	firstdrv_class = class_create(THIS_MODULE,"leds");
	firstdrv_class_dev[0] = class_device_create(firstdrv_class,NULL,MKDEV(major,0),NULL,"leds"); /* /dev/xyz设备节点 */
	
	for(minor=1;minor<4;minor++)
	{
		firstdrv_class_dev[minor] = class_device_create(firstdrv_class,NULL,MKDEV(major,minor),NULL,"led%d",minor); /* /dev/xyz设备节点 */
	}
	
	
	
	gpfcon = (volatile unsigned long *)ioremap(0x56000050,16);
	gpfdat = gpfcon+1;
	
	return 0;
}

void first_drv_exit(void)
{
	int minor = 0;
	unregister_chrdev(major,"first_drv");/* 卸载驱动 */
	
	for(minor=0;minor<4;minor++)
	{
		class_device_unregister(firstdrv_class_dev[minor]);
	}
	
	class_destroy(firstdrv_class);
	
	iounmap(gpfcon);
	
}

/* 指定驱动程序的初始化函数和卸载函数 */
module_init(first_drv_init);
module_exit(first_drv_exit);

/* 描述驱动的信息 非必需 */
MODULE_AUTHOR("Johnny");
MODULE_VERSION("0.1.0");
MODULE_DESCRIPTION("JZ2440");
MODULE_LICENSE("GPL");









